/*
 * Matrix4d.cpp
 *
 *  Created on: Mar 21, 2013
 *      Author: ayran
 */
#include <iostream>
#include "../include/Matriz4d.h"

Matriz4d::Matriz4d(){
}
Matriz4d::Matriz4d(double* values) {

	mNormal= 		Coordenada3d(values[0],values[1],values[2]);
	mOrientation=	Coordenada3d(values[4],values[5],values[6]);
	mApproach=		Coordenada3d(values[8],values[9],values[10]);
	mPosition=		Coordenada3d(values[12],values[13],values[14]);

//	std::cout << "na matriz 4ddd"<<mPosition.toString()<<std::endl;
//matriz eh montada de acordo com o descrito na wiki do simspark.
}

Matriz4d::~Matriz4d()
{
}

Coordenada3d
Matriz4d::getPosition()
{
	return mPosition;
}

Coordenada3d
Matriz4d::getNormal()
{
	return mNormal;
}

Coordenada3d
Matriz4d::getApproach()
{
	return mApproach;
}

Coordenada3d
Matriz4d::getOrientation()
{
	return mOrientation;
}
